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ABSTRACT 


This thesis presents the continued design and system integration of a prototype 
three Degrees-Of-Freedom (DOF) Spacecraft Simulator used in the Proximity Operations 
Simulator Facility, as part of the Naval Postgraduate School’s Spacecraft Robotics 
Laboratory, to simulate autonomous guidance, navigation and control (GNC) for 
spacecraft proximity operations and assembly as part of the Autonomous Multi-Agent 
Physically Interacting Spacecraft project. Several key enhancements of the spacecraft 
simulator were made including the integration of onboard sensors, improved electrical 
distribution system, improved command and data handling system, and the design and 
integration of vectorable thrusters. 

A pair of independently controlled 360 degree vectorable thrusters is now 
included in the spacecraft simulator. A control system and thruster mapping algorithm 
were developed to incorporate the translational and rotational control authority that the 
vectorable thrusters provide with the rotational control authority of the previously 
developed Miniature Single-Gimbaled Control-Moment-Gyroscope (MSGCMG). 
Simulation and experimental results are presented to demonstrate the functionality of the 
prototype AMPHIS vehicle. The work done in developing the prototype vehicle will 
enable rapid fabrication of additional vehicles to provide essential hardware-in-the-loop 
experimentation capabilities for evolving control algorithms, sensors and mating 
mechanisms to be used for autonomous spacecraft assembly. 
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I. INTRODUCTION 



Figure 1. Globally Distributed Fractionated Spacecraft (Ref. [1]) 

A. MOTIVATION FOR MULT-AGENT SPACECRAFT SYSTEMS 

The Autonomous Multi-Agent Physically Interacting Spacecraft (AMPHIS) test 
bed is designed for the purpose of testing various control and navigation methods that 
could be used for the autonomous interaction of multiple homogenous fractionated 
spacecraft network during proximity operations. Current space systems use a one time, 
single use model for accomplishing a specific mission. These space systems are 
developed and operate under a high level of risk. The traditional approach to managing 
these risks is increased design margin and built in redundancy, both of which lead to 
higher cost. 

Fractionated spacecraft systems may offer an architectural diversity approach to 
manage this risk. They offer greater flexibility, diversification of risk, and spatial 
distribution. Homogeneous fractionated spacecraft systems are composed of several 
identical interacting agents that are small-scale replicas of a traditional large spacecraft 
and are fully capable of functioning independently of each other. No longer would a 
single, costly rocket launch be needed for all missions; instead, some missions could be 
launched in multiple smaller vehicles as independent units. Once on orbit, the units 


1 







would autonomously maneuver and dock to form a single functioning satellite to perform 
a single mission. (Ref. [2]) 


B. CURRENT MULTI-AGENT SPACECRAFT SIMULATORS 


The task of multiple autonomous spacecraft operating in a coordinating manner 
requires the development of highly technical control systems. Using smaller, 
independent spacecraft vehicles requires exploring new sensor and actuator approaches in 
order to perform all the necessary functions in a small platform. The high cost involved 
with on orbit testing, along with the need to develop new control systems, leads to the 
necessity of developing and utilizing multi-agent spacecraft simulators. A shortlist of 
available simulators is presented here below. 

1. MIT Synchronized Position Hold Engage and Reorient Experimental 
Satellites (SPHERES) Laboratory 

The MIT Space Systems Laboratory developed the SPHERES (Synchronized 
Position Hold Engage and Reorient Experimental Satellites) laboratory environment to 
provide DARPA, NASA, and other researchers with a replenishable and upgradeable test 
bed for the validation of high risk control and autonomy technologies used in formation 
flight and autonomous docking, rendezvous and reconfiguration algorithms. The test bed 
consists of three small, self-contained vehicles, or "spheres," which can control their 
relative positions and orientations, and is operable on a 2-D laboratory platform, NASA's 
KC-135 (shown in Figure 2), and the International Space Station. (Ref. [3]) 



MIT SPHERES Testing on KC-135 (Ref. [3]) 


Figure 2. 
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2. JPL 6 DOF Formation Control Test bed 

JPL’s six Degrees of Freedom (DOF) capable Formation Control Test bed (FCT), 
shown in Figure 3, is designed to support technology demonstration and development of 
the requisite control algorithms for fractionated spacecraft interaction. Each FCT robotic 
vehicle consists of a star tracker, a CG balanced attitude platform containing three 
reaction wheels, 16 IN air thrusters, wireless Ethernet and a compactPCI Bus 
PowerPC750 flight computer. A linear air bearing, three air pads and a vertical stage 
provide 6 DOF for each vehicle by 16 3000 PSI air tanks. Each of three robots stands 
64.5 inches high with a diameter of 59.5 inches, weighs approximately 358 kg and 
operates in a 40 foot diameter room. (Ref. [4]) 



Figure 3. JPL Formation Control Test bed (Ref. [4]) 


3. NPS SRL Previous Work 

The Spacecraft Robotics Laboratory (SRL) at the MAE Department of the Naval 
Postgraduate School supports the Graduate School of Engineering and Applied Science 
(GSEAS), the Space Systems Academic Group (SSAG), and conducts research for the 
Air Force Research Lab (AFRL) (Space Vehicle Directory), Defense Advanced Research 
Projects Agency (DARPA) (Tactical Technology Office), and various sponsoring agents. 
The first interacting spacecraft simulator robot project conducted in the SRL at NPS was 
the Autonomous Docking and Servicing Spacecraft Simulator (AUDASS), shown in 
Figure 4. (Ref. [5], [6], [7]) 
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Figure 4. Autonomous Docking Test bed at the NPS SRL (Ref. [5], [6], [7]) 


The Proximity Operations Simulator Facility (POSF) was developed to validate 
Guidance, Navigation, and Control (GNC) approaches for autonomous docking and 
fractionated spacecraft missions. The facility utilizes computer modeling and simulation 
with hardware in the loop testing. The facility consists of a 4.9 m x 4.3 m epoxy floor 
with indoor GPS and floating spacecraft simulators. (Ref. [5], [6], [7], [8]) 

As a follow on spacecraft simulator to the AUDASS test bed, the AMPHIS test 
bed has been developed. The benefits of the AMPHIS test bed over the AUDASS test 
bed is a smaller, more modular design that utilizes more commercial of the shelf (COTS) 
equipment making it is less expensive platform. These benefits will along for the 
construction of more simulators and the testing of multiple different sensor, actuator, and 
controller combinations easily. The previous work on the development of the AMPHIS 
test bed, shown in Figure 5, consisted of the physical structures, the air system, the 
electrical system, and the design and development of a Miniature Single Gimbaled 
Control Moment Gyro (MSGCMG). This initial development of AMPHIS is 
documented in Ref. [8]. 
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Figure 5. Early AMPHIS Spacecraft Simulator (Ref. [8]) 

4. Scope of Thesis 

The goal of this thesis is to document the further development of the AMPHIS 
test bed. The new developments made include improvements to air and electrical 
systems, the addition of onboard sensors, the development of the command and data 
handling (C&DH) system, and the addition of vectorable thruster actuators. 

The improvements that are made to the air and electrical systems have double the 
endurance of the spacecraft simulator. A fiber optic gyro, a three-axis accelerometer, an 
iGPS receiver, as well as a LiDAR sensor have all been added to the spacecraft simulator. 
A pair of vectorable thrusters has also been added, giving the spacecraft simulator 
translational control authority adding to the attitude control provided by the MSGCMG. 
All of the necessary software required to integrate these sensor with the C&DH system 
have also been developed. 

In addition to the hardware improvements, a controller and actuator mapping 
algorithm has been developed. These improvements, along with high level software 
development and LiDAR integration, discussed in Ref. [9], allow for full system testing 
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of the AMPHIS test bed. Several rendezvous maneuver experiments have been 
successfully completed. Simulation and experimental results are provided. 
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II. COMPLETION OF THREE DEGREES-OF-FREEDOM (DOF) 
PROTOTYPE SPACECRAFT SIMULATOR 
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3000 psi 
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Figure 6. Prototype Spacecraft Simulator for the AMPHIS Test bed in the POSF 

A. OVERVIEW OF SPACECRAFT SIMULATOR UPGRADES 

A three degree-of-freedom spacecraft simulator, shown in Figure 6, was 
developed for use in the AMPHIS test bed. Much of the early development of the 
spacecraft simulator, including structures, initial air and electrical systems, and the design 

of a Miniature Single Gimbaled Control Moment Gyro (MSGCMG) had been 
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accomplished earlier and are described in detail in Ref. [8]. The following sections 
describe the remaining work that has been done including improved air and electrical 
systems, further development of the command and data handling system, the addition of 
onboard sensors, and the addition of vectorable thrusters. 

The overall layout of components in the spacecraft simulator has been drastically 
altered. This new arrangement allows for the addition of two additional air cylinders, an 
additional battery, and the addition of another gyroscope to the MSGCMG assembly. 
These enhancements allow for longer simulation run times as well as increasing the 
attitude control authority of the MSGCMG. The new overall spacecraft simulator 
characteristics are depicted in Table 1. 
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Size 

Length and Width 

.30 [m] 

Height 

.69 [m] 

Mass 

37 [kg] 

Moment of Inertia about Z C h 

.75 [kg m 2 ] 

Flotation 

Source 

Air 

Equivalent Storage Capacity @21 [MPa] 
(3000 PSI) 

.002 [m 3 ] 


Operating Pressure 

0.35 [MPa] (50 PSI) 

Propulsion 

Propellant 

Air 

Equivalent Storage Capacity @21 [MPa] 
(3000 PSI) 

.002 [m 3 ] 



Operating Pressure, Thrusting 

120 PSI 

Cont. Operation (No Thrust Factored) 

75 [min] 

Thrust of Each Thruster 

.28 [N] 

CMG Max Torque 

.334 [Nm] 

CMG Max Ang. Momentum 

.049 [Nms] 

Electrical & 
Electronic 
Subsystem 

Battery Type 

Lithium-Ion 

Storage Capacity 

12 [Ah] @ 28[V] 

Computers 

2 PC 104 Pentium III 

Sensors 

Fiber Optic Gyro Bias 

±20°/hr 

LiDAR Sensor 

Under Development 

Optical Position Validation Sensor 

Under Development 

Pseudo-GPS Sensor Accuracy 

< .050 [mm] 

Accelerometers Bias Stability 

± 8.5M0 3 g 

Docking I/F 

Magnetic 

Under Development 


Table 1. Updated Key Parameters of the AMPHIS Prototype Spacecraft Simulator 
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B. 


AIR SUPPLY SYSTEM IMPROVEMENTS 



Pressure 

Regulators 


Air Cylinders 


Vectorable 

Thrusters 


Figure 7. Lower Module Layout 


The key enhancement to the air supply system involves the separation of the 
floatation and propulsion air subsystems, shown in Figure 8. Each subsystem is now 
supplied by two 68 cubic inches, 3000 PSI carbon fiber air cylinders, for a total of four 
cylinders, doubling the onboard air storage capacity. This arrangement has the benefit of 
allowing individual testing and actuation of the subsystems. This arrangement also 
ensures that the floatation subsystem receives an adequate air supply regardless of the 
demand placed on the air supply system by the thrusters. Another improvement was the 
additional of a fourth air pad and relocating the four air pads in four corners of the bottom 
of the lower module. This fourth air pad ensures that the simulator will float easily with 
the added weight of the additions made to the simulator. The floatation system operates 
at 40 PSI while the propulsion system operates at 120 PSI. Further details of the air 
system along with filling the air cylinders are described in Ref. [8]. 
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Figure 8. Air System Schematic (Ref. [8]) 



Figure 9. Middle Module Layout 
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They key enhancement to the electrical distribution system, shown in Figure 10, is 
the addition of another battery. This change, along with the addition of the two air 
cylinders for the air system, required a complete redesign of the electrical distribution 
system layout. The electrical system was moved from the lower module to the upper and 
middle modules, as shown in Figure 6. 
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Figure 10. Electrical Distribution System Schematic (Ref. [8]) 
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Three Ultralife UBBL02 Lithium Ion batteries are located in the middle module, 
surrounding the MSGCMG. The UBBL02 contains two internal cells, shown in Figure 
11, each with a voltage of 16 VDC, that are wired in series by connecting the output pins 
five and three together and using pins two and four to connect the battery to the load. 
This configuration increases the output voltage to 32 VDC. Each battery has a six Ah 
capacity at 32 VDC, for a total capacity of 18 Ah for the spacecraft simulator. 



Figure 11. 


Ultralife UBBL02 Lithium Ion Battery Schematic (Ref. [10]) 


The batteries are connected thru a mechanical switch to a Vicor four output 
terminal VIPAC DC-DC converter array mounted in the upper module. The DC-DC 
converter array contains one five VDC DC-DC converter and three 24 VDC DC-DC 
converter. The DC-DC converter array itself draws approximately .25 A of current or 
approximately 8 W of power. Another key design change was redistributing the loads 
among the DC-DC converters, specifically the 24 VDC converters. Each PC-104 is 
connected to its own dedicated 24 VDC converter, with the third converter being used to 
power the LiDAR, the air solenoid valves, and the DC motors used to manipulate the 
MSGCMG and the vectorable thrusters. The power requirements for all of the individual 
components are listed in Table 2. The total power requirement the spacecraft simulator is 
approximately 100 W at 32 VDC. 
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Component 

Voltage Reqs 
(Max Power) 

Component 

Voltage Reqs 
(Max Power) 

(2) Versalogic 
EPM-CPU-10 

5 [V] (21 [W]) 

SICK LD-OEM 
LiDAR 

24 [V] (15 [W]) 

Netgear 

4 Port Router 

12 [V] (6 [W]) 

(3) ASCO 
Solenoid Valves 

24 [V] (6 [W]) 

(3) Maxon 
Motor EPOS 
24/1 Encoder 

24 [V] (2 [W]) 

KVH DSP-3000 
Fiber Optic Gyro 

5 [V] (2 [W]) 

(3) Super 
Precision Gyro 
Motor 

5 [V] (1 [W]) 

Crossbow 

CXL02TG3 

Accelerometer 

5 [V] (10 [mW]) 

VICAP DC-DC 
Converter 

24-40 [V] (8 [W]) 

Metris iGPS 

Own Power Source 


Table 2. Spacecraft Simulator Electrical Loads (Ref. [8]) 

D. COMMAND AND DATA HANDLING SYSTEM 



Figure 12. Upper Module Layout 

The Command and Data Handling (C&DH) system is responsible for all of the 

control functions and communications for the spacecraft simulator. The C&DH consists 

of two PC-104 computers, a mechanical relay board, a 50 terminal connection board, and 
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a wireless router. All of these components, with the exception of the wireless router, are 
located in the upper module. The wireless router is located underneath the sensor deck. 
Due to current hardware limitations, there is also an off board computer running Lynx 
that is used to retrieve Indoor Global Positioning System (iGPS) information. 

One PC-104 is used to run the MATLAB XPC Target Operating System 
delivering real-time control capability to the simulator while the second PC-104 is used 
to run Windows XP and processes the raw Laser Scanner and iGPS information into 
useable data and then sends this processed data to the control computer. The size, 
capability and rapid upgradeability of embedded PC-104 computers drove their selection 
over other types of CPUs. Both PC’s are equipped with Ethernet and RS-232 serial ports 
used to connect them to each other through the router and to the pertinent sensors 
respectively. (Ref. [8]) 



Figure 13. Versalogic Jaguar EPM-CPU-10 PC-104 (Ref. [11]) 

The PC-104’s used for the spacecraft simulator are the Versalogic Jaguar EPM- 
CPU-10 PC-104, shown in Figure 13. The Versalogic Jaguar is running on an 850 MHz 
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Pentium III processor with 256 MB DRAM (Dynamic Random Access Memory). It is 
equipped with KVM, dual USB, Ethernet, dual RS-232 communication ports, and IDE 
disk drive and a 3.5 inch floppy drive connections. (Ref. [8]) 
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Figure 14. AMPHIS Data Handling Schematic 


The overall data processing scheme for the AMPHIS test bed is depicted in Figure 
14. The communication between the two onboard computers of the spacecraft simulator 
is handled thru the onboard wireless router via wired Ethernet connections. All 
communication off the spacecraft simulator is thru the Windows XP computer and its 
wireless Ethernet adapter. A wireless router for the AMPHIS test bed links the various 
spacecraft simulators, the test bed development computer, and the Lynx computer 
together. The IP address and port configuration scheme for the test bed facility, including 
the individual spacecraft simulators, is depicted in Table 3. Further discussion of the 
TCP/IP architecture is provided in Ref. [9]. 
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IP Address (192.168.) 


Device 

Robotl 

Robot2 

Robot3 

Shore 






ETHERNET (.1.) 





Router 

111 

211 

311 


Windows 

112 

212 

312 


xPC 

113 

213 

313 







WIRELESS (.2.) 





SSID 

heweynet 

leweynet 

deweynet 

amphisnet 

Router 

111 

211 

311 

1 

Windows / Linux 

112 

212 

312 

10 


Port Numbers 




FROM 









Winl 

Win2 

Win3 

xPCI 

xPC2 

xPC3 

Linux 

TO 

Winl 


5021 

5031 

4001 



5000 


Win2 

5012 


5032 


4001 


5000 


Win3 

5013 

5023 




4001 

5000 


xPCI 

4002 








xPC2 


4002 







xPC3 



4002 






Linux 

GPS 

GPS 

GPS 






Table 3. IP Address and Port Configuration Scheme (Ref. [9]) 


1. XPC Target Computer 

The PC-104 stack used for the XPC Target computer contains, in addition to the 
Jaguar computer, a TRI-M Engineering 75W PC-104 power supply, a M-Systems 96MB 
Disk On Chip (DOC) flashdisk, a Versalogic Quad RS-232 Module, and a Diamond 
Systems DMM-32X-AT 16-bit Analog I/O Module. The XPC Target computer is 
connected via RS-232 connections to the MSGCMG, the two vectorable thrusters’ 
slewing motor, and may be connected to the Fiber Optic Gyro. The computer is 
connected to the onboard wireless router via its own Ethernet wire connection. The 12 
VDC output of PC-104 power supply is to power the onboard wireless router. Detailed 
instructions for the setup of the XPC Target computer are in Appendix B. The 
SIMULINK model used for XPC Target control computer is shown in Figure 15. Full 
detail on the XPC Target SIMUFINK model development is provided in Ref. [9]. 



Figure 15. XPC Target Computer SIMUFINK Model (Ref. [9]) 
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A 50 pin ribbon connecter is used to connect the analog interface of the DMM- 
32X-AT module to a 50 terminal connection board. This connection board is used to 
connect the accelerometer to the computer. A 34 pin ribbon cable is used to connect to 
the digital interface of the DMM-32X-AT module to a RTD DMR-8 Mechanical Relay 
Output Board, both shown in Figure 16. The DMR-8 has a 50 pin connection and uses a 
different wiring scheme than the DMM-32X-AT. Therefore, the opposite end of the 34- 
pin connection is changed with a 50 pin female connecter. Only the first 8 bits (A0-A7, 
pins 1-8) of the DMM-32X-AT are used to communicate with the DMR-8 along with the 
five VDC and digital ground connection (pin 33 and 34). Wires one thru eight of the 34 
pin ribbon cable are connected onto connections 33, 35, 37, 39, 41, 43, 45, and 47 
respectively, corresponding to DIN zero thru seven on the DMR-8. Wires 33 (5 VDC) 
and 34 (Dgnd) are connected to connections 49 and 50 respectively on the DMR-8 to 
provide power to DMR-8. 
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®@ 
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Figure 16. DM-32X-AT Digital I/O Connection Diagram (Ref. [12]) and DMR-8 
Mechanical Relay Board Connection Diagram (Ref. [13]) 

2. DMR-8 Mechanical Relay Board 

The DMR-8 isolates the low power TTL signal of the digital outputs of the XPC 
Target computer from the high voltage (24 VDC) power supply used to actuate the 
solenoids for the vectorable thrusters, the air supply to air pads of the floatation system, 
and future uses such as actuating docking mechanisms. Each mechanical relay has a 
normally open (NO), a normally closed (NC), and a common connection (COM), as 
shown in Figure 17. When a high TTL signal is sent to the mechanical relay, the relay 
closes the NO terminal, opens the NC terminal, and illuminates the LED. 
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Figure 17. Mechanical Relay Circuit Diagram (Ref. [13]) 


All of the COM connections on the DMR-8 are connected thru a terminal board to 
a -24 VDC connections of one of the 24 VDC regulators on the DC-DC converter. This 
allows the mechanical relay board to interrupt the ground connection on attached devices, 
effectively turning them on or off. The NS or NO connections are combined together 
with a +24 VDC and ground to a combined wire bundle with a 15 pin serial connector on 
the end, according to the wiring scheme depicted in Table 4. The 15 pin serial connector 
allows for easy disconnection in order to separate the individual modules of the 
spacecraft simulator. The opposite end of the combined wire bundle is connected to a 
screw terminal board, set up in pairs of +24 VDC and the individual relay board 
connections to allow for easy connection of individual devices. 
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Pin Number 

Color 

Connection 

1 

Brown 

DIN 0 (NS) 

2 

Purple 

DIN 1 (NO) 

3 

Orange 

DIN 2 (NO) 

4 

Yellow 

DIN 3 (NO) 

5 

Light Blue 

DIN 4 (NO) 

6 

White 

DIN 5 (NO) 

7 

Gray 

DIN 6 (NO) 

8 

Green 

DIN 7 (NO) 

9 

Red 

+24 VDC 

15 

Black 

GRND 


Table 4. 15 Pin Serial Connector Wiring Scheme 

3. Windows XP Computer 

The PC-104 stack used for the Windows XP computer contains, in addition to the 
Jaguar computer, a RTD 75W PC-104 power supply, a Fujitsu 3.5” laptop hard drive, and 
a Versalogic Quad RS-232 Module. The Windows XP computer is connected via RS- 
232 connections to the iGPS and LiDAR sensors, and may be connected to the Fiber 
Optic Gyro. The computer’s USB connection is used to connect it to a wireless Ethernet 
adapter and the computer is connected to the onboard wireless router via its own Ethernet 
wire connection. The PC-104 five VDC output of the PC-104 power supply is used to 
power the hard drive. The Windows XP computer runs the host software for the iGPS as 
well as SIMULINK. Detailed instructions for the setup of the Windows XP computer are 
found in Appendix C. It is this SIMULINK model, shown in Figure 18, that runs all of 
the communications for the spacecraft simulator as well as do all of the LiDAR 
processing. The communication architecture and LiDAR processing are discussed in 
detail in Ref. [9]. 
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Figure 18. Windows XP Computer SIMULINK Model 
E. SENSORS 



Figure 19. Sensor Module Layout 
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1 . 


Fiber Optic Gyro 



Figure 20. KVH DSP-3000 Fiber Optic Gyro (Ref. [14]) 


A KVH fiber optic gyro (FOG) provides the attitude measurement requirements 
for the spacecraft simulator. The KVH DSP-3000 FOG selection is based on its compact, 
lightweight frame, its low rate bias term and its serial interface. The Digital 100Hz 
Asynchronous (KVH part number 02-1222-01) variant is used. The KVH FOG 
specifications are provided in Table 5. 
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Attribute 

Rating 

Performance 

Maximum Input Rate 

±375°/sec 

Update Rate 

100 Hz 

Angle Random Walk (noise) 

4°/hr/ VHz 

Initialization Time 

< 5 sec 

Bias 

Offset (room temp) 

±20° /hr 

Stability (room temp) 

l°/hr, la 

Temperature Sensitivity (< l°C/min ) 

6°/hr, la 

Electrical 

Input Voltage 

+5 VDC ±10% 

Power Consumption 

3 watts max, 2 watts norm 

Output 

Baud Rate 

38,400 Baud (RS-232) 

Parity 

None 

Data bits 

8 

Stop bits 

1 

Flow Control 

None 

Physical 

Dimensions 

88.9 mm x 58.42 mm x 33.02 mm 

Weight 

0.27 kg 


Table 5. KVH DSP-3000 Specifications (Ref. [14]) 


As shown in 0, the gyro senses rotation on an axis perpendicular to the plane of 
the base plate about its centroid. The gyro is mounted underneath the upper module of 
the spacecraft simulator. This ensures that the gyro is perpendicular to the floor of the 
laboratory with its centroid located approximately centerline to the spacecraft simulator, 
aligning the gyro’s axis of rotation with the Z-axis of the spacecraft simulator. Looking 
at the gyro overhead, a clockwise rotation corresponds to a positive output. The inverted 
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mounting underneath the upper platform corrects this convection to coincide with the 
normal right-hand rule convention with the X and Y axes of the laboratory. 

The DSP-3000 is equipped with a 15-pin interface connector, shown in Figure 21, 
located on one of the long ends of the gyro. With the connector positioned at the top of 
the gyro wall, pin 1 is located on the right side when viewing the connector head-on. 
Tyco Electronics’ single-row Dualobe connector (Tyco part number SSM015L2HN, 
KVH part number 32-0780) is used to interface with the gyro connector. This mating 
connector provides 12 inch leads. 



Figure 21. KVH DSP-3000 Interface Connector (Ref. [14]) 

Figure 22 illustrates the wiring diagram for the gyro. Pin one (power) is 
connected to the positive five VDC output of the DC-DC converter, while pins two and 
three (power and case ground) are connected to the DC-DC converter negative five VDC 
output. Pins nine, 10, and 11 correspond to the RS-232 communication for the gyro. Pin 
nine (Tx), 10 (Rx), and 11 (signal ground) are combined to form the pins two, three, and 
five of a RS-232 female connector respectively. This RS-232 connecter can be connected 
to one of the serial COM ports on either the Windows XP or XPC Target PC-104’s. 
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Figure 22. KVH DSP-3000 Wiring Diagram (Ref. [14]) 

There are several data output formats that the KVH DSP-3000 gyro can provide. 
They include angular rate, incremental angle, and integrated angle. The output mode is 
determined by sending a single ASCII character to the gyro without a carriage return or 
line feed. An additional command is available to zero the integrated angle value. A list 
of commands is listed in Table 6. A command may need to be sent more than once for 
the command to execute. 


Command 

Function 

R 

Switch output to Rate 

A 

Switch output to Incremental Angle 

P 

Switch output to Integrated Angle 

Z 

Zero the Integrated Angle value 

Table 6. 

KVH DSP-3000 User Commands (Ref. [14]) 


The output data is in the form of a continuous ASCII text stream consisting of two 
decimal words separated by three space characters and followed by a carriage return/line 
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feed sequence. The first data word begins four space characters after the line feed 
character. Its content represents angular rate (degs/sec), incremental angle (deg), or 
integrated angle (deg) to six decimal point precision. The second data word consists of a 
single ASCII character of either zero for fault or one for data valid. For the spacecraft 
simulator, only the rate mode is used. Angular position is found by integrating the rate 
information. 

Two separate methods were developed to retrieve this information from the gyro, 
allowing the gyro sensor to be connected to either the XPC Target computer or the 
Windows XP computer running SIMULINK. Figure 23 and Figure 24 illustrate the 
SIMULINK models used. Appendix E contains the MATLAB code used for the gyro. 



Figure 23. XPC Target Gyro SIMULINK Model 



Figure 24. Windows XP Gyro SIMULINK Model 


A rate bias term must be subtracted out from the measured rate in order to account 
for the rotation of the earth. The angular rate due to the earth’s rotation can be found 
using equation(l). 

Earth Rate (deg/hour) = -15.04107 *sm(latitude) (1) (Ref. [14]) 
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2 . 


Accelerometer 



Figure 25. Crossbow CXL02TG3 Tri-Axial Precision Accelerometer (Ref. [15]) 

A Crossbow CXL02TG3 Tri-Axial Precision Accelerometer provides inertial 
measurements for the spacecraft simulator for the two axes of translational motion. The 
accelerometer, shown in Figure 25, is mounted in the upper module, centerline, with two 
of its axes (X and Y) aligned the X and Y body axes of the space craft simulator 
respectively. The third axis (Z-axis) is not used, since the spacecraft simulator has no 
movement along that axis. Table 7 lists the Crossbow accelerometer specifications. 
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Attribute 

Rating 

Performance 

Input Range 

±2g 

Bias Stability 

±8.5 mg 

Sensitivity 

833 mV/g 

Noise at 100 Hz Bandwidth 

.6 mg rms 

Electrical 

Input Voltage 

+5 VDC 

Power Consumption 

1.5 mW 

Output 

Zero-g Voltage 

2.49-2.51 VDC 

Physical 

Dimensions 

2.81 mm x 5.68 mm x 3.65 mm 

Weight 

0.11kg 


Table 7. Crossbow CXL02TG3 Specifications (Ref. [15]) 


The Crossbow accelerometer is equipped with an analog interface allowing for 
direct connection through the Diamond Systems DMM-32X-AT 16-bit Analog I/O PC- 
104 module to XPC Target computer. Table 8 depicts the wiring scheme for the 
accelerometer. The five VDC and ground wires are connected to terminals 49 and 50 
respectively on the 50 pin analog terminal board. This enables the accelerometer to be 
powered by the XPC Target computer. The X-axis and Y-axis wires are connected to 
terminals 25 and 27 respectively. The Z-axis wire is not used due to no movement in the 
Z direction and the temperature wire is not used due to the near constant temperature of 
the laboratory environment. 
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Color 

Function 

Red 

5 VDC 

Black 

GRND 

White 

X-axis 

Yellow 

Y-axis 

Green 

Z-axis 

Blue 

Temperature 


Table 8. Crossbow Accelerometer Wiring Scheme (Ref. [15]) 

The output from the X and Y axis leads is in the form of an analog signal ranging 
from zero to five volts. The calibration data provided by Crossbow relates output voltage 
to G’s of acceleration. Zero-G voltage is approximately 2.52 volts. The sensitivity of the 
output voltage is approximately .845 volts IG. Figure 26 illustrates the SIMULINK 
model used in XPC Target to communicate with the accelerometer. 



Figure 26. Accelerometer SIMULINK Model 


3. Indoor Global Positioning System (iGPS) 

The spacecraft simulator and POSF are equipped with the Indoor Global 
Positioning System (iGPS) by Metris. This system is similar to the on-orbit GPS in that 
it is capable of providing high precision position determination. However, unlike the use 
of radio signals by orbiting GPS satellites, the iGPS uses laser transmitters to cover the 
test bed with infrared light that is detected and then processed using on-board software, 
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WORKSPACE. (Ref. [16]) The WORKSPACE software is loaded and run on the 
onboard the Windows XP computer. The procedures for setting up iGPS and installing 
the WORKSPACE software for use with the AMPHIS test bed are found in Ref. [6] and 
Ref. [8], 

The iGPS receiver and battery pack are fixed underneath the top sensor deck. The 
iGPS antenna is located on top of the LiDAR sensor to ensure that it has continuous line 
of sight with the iGPS transmitters located in the POSF. This arrangement causes a small 
‘blind spot’ for the LiDAR sensor, but the software developed in Ref. [9] is take it into 
account. The iGPS is connected via RS-232 cable to the one of the COM ports on the 
onboard Windows XP computer. 

Due to temporary limitations with the current WORKSPACE software, an off 
board computer mnning the Lynx operating system, uses C code to retrieve the iGPS 
information via IP/TCP communication and relays that information back to the onboard 
Windows XP computer via UDP communication, which then passes the information onto 
the XPC Target computer for state estimation calculations. This awkward arrangement 
will be resolved with future versions of iGPS. 
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4. Light Detection and Ranging (LiDAR) Sensor 



Figure 27. SICK LD-OEM Laser Scanner (Ref. [20]) 


The primary sensor for determining the relative bearing and range of other 
spacecraft simulators on the AMPHIS test bed is the SICK LD-OEM Laser Scanner, 
shown in Figure 27. The mirror assembly on the top of the scanner rotates about the Z 
axis of the simulator, providing range and bearing information from the return of the 
reflected transmitted laser pulses in the X-Y plane, providing the spacecraft simulator at 
2-D view of the AMPHIS test bed environment. The LiDAR provides the spacecraft 
simulator with a 360 degree view of the POSF, as shown in Figure 28. 
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Figure 28. Sample LiDAR Image of POSF (Ref. [9]) 

The LiDAR sensor is mounted on top of the sensor deck of the spacecraft 
simulator. It is powered with 24 VDC from the one of the 24 VDC regulators on the DC- 
DC converter. The LiDAR is connected via a RS-232 connection to the onboard 
Windows XP computer. The software developed to communicate with the LiDAR is run 
as part of the Windows XP computer SIMULINK Model along with the communication 
blocks. The software development for the LiDAR is discussed in detail in Ref. [9]. 


F. ACTUATORS 

1. Miniature Single Gimbaled Control Moment Gyro (MSGCMG) 

A MSGCMG assembly mounted in the second module, shown in Figure 9, 
provides attitude control for the spacecraft simulator. A Super Motorized Precision 
Gyroscope by Educational Innovations, Inc. is at the core of the assembly. The 
gyroscope is rotated on the plane of the spinning rotor wheel by a graphite brush DC 
motor, commanded through an encoder both manufactured by Maxon Motor. A RS-232 
interface provides the hardware interface between the XPC Target control computer and a 
Maxon Motor EPOS 24/1 digital motion controller. A second gyroscope was added to 
give additional attitude control authority. The hardware integration and development of 

the XPC Target control software for the EPOS 24/1 will be discussed in a proceeding 
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section. The technical characteristics for the MSGCMG are found in Table 9. Further 
discussion about the development of the MSGCMG and its performance can be found in 
Ref. [8], 


Rotor Wheel 

Moment of Inertia Wheel ( J w ) 

3.717M0 3 [kg-m 2 ] 

Maximum Momentum Wheel ( h w ) 

49.4.M0” 3 [N-m-s] 

Maximum Wheel Speed 

±1256.6 [rad/s] (12000 rpm) 

Power Supply 

5 [VDC] 

Gimbal Motor & Encoder 

Maximum Gimbal Rate 

6.95 [rad/s] (398 deg/s) 

Maximum Gimbal Acceleration 

109.9 rad/s 2 (6297 deg/s 2 ) 

Maximum Gimbal Torque 

4.06.M0 3 [N-m] 

CMG 

Total Mass of CMG (including 
mounting hardware) 

1.148 [kg] 

Power Supply 

9-24 VDC 

Maximum Output Torque 

.344 [N-m] 

Power 

< 24 [W] 

Interface 

RS-232 

Dimensions 

.02 [nr] 


Table 9. MSGCMG Technical Specifications (Ref. [8]) 
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2 . 


Vectorable Thruster 



Figure 29. Vectorable Thruster 


A pair of independently controlled vectorable thrusters, shown in Figure 29, 
provide translational as well as attitude control for the spacecraft simulator. The 
vectorable thrusters are mounted on opposite sides of the spacecraft simulator in the 
lower module, as shown in Figure 7. They are constructed of a Maxon brushless DC 
motor with a EPOS 24/1 digital motion controller used for slewing, a Predyne EH-2012 
air solenoid used for thruster activation, and a Silvent MJ4 air nozzle to guide the air flow 
out of the solenoid. The hardware integration and development of the XPC Target 
control software for the EPOS 24/1 will be discussed in the proceeding section. 
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Figure 30. Predyne EH-2012 Air Solenoid Schematic (Ref. [17]) 

The EH-2012 air solenoid, shown in Figure 30, is a two-way normally closed 
electric valve. In order to actuate or open the solenoid valve, power (24 VDC) must be 
supplied to the valve. The 24 VDC power supply used to control the air solenoid is 
supplied thru the mechanical relay board, controlled by the XPC Target computer. A 
complete discussion on this hardware interface is discussed in the previous section on the 
C&DH system. The air solenoid characteristics are found in Table 10. 


Parameter 

Value 

Max Pressure 

100 psi 

Orifice Diameter 

1.6 mm 

Cv Factor 

.050 

Minimum Cycle Time 

3-5 milliseconds 

Power Requirement 

24 VDC (2 W) 

Dimensions 

40.8 mm x 18.6 mm (dia.) 

Weight 

.015 kg 


Table 10. Predyne EH-2012 Air Solenoid Specifications (Ref. [17]) 


The digital output signal generated by the DMM-32X-AT Analog I/O module is 
controlled by the SIMULINK model shown in Figure 31. The two independent required 
thrust signals generated by the controller are sent to the MM-32 Diamond Digital Output 
SIMULINK control block. Relay blocks are used to ensure the required TTL value of .5 
is sent to the digital output block when a thrust is required. The digital control block also 
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controls the air solenoid used to actuate the floatation system. Time activated switches 
ensure that the thrusters and air pads are deactivated at the end of an experiment. 



Figure 31. Air Solenoid Control SIMULINK Model 


Calibration runs of continuous thrust, shown in Figure 32, were used to determine 
the actual thrust output of the thrusters. The iGPS sensor was used to record position 
information. A first order transfer function, shown in equation(2), was used to calculate 
the first and second derivatives, corresponding to velocity and acceleration, from the 
position information. 


S 

5 + 1 


( 2 ) 


From the data in Figure 32, a near constant acceleration of 
approximately .0075 m/s 2 . Based on the spacecraft simulator mass of 37 kg, this constant 
acceleration value corresponds to a constant thrust value of .28 N for each thruster. 
Based on the physical location of the vectorable thrusters, they each have a moment arm 
of .15 meters. This allows the thrusters to apply a max torque on the spacecraft simulator 
of .084 Nm, compared to the .344 Nm available from MSGCMG. However, the angular 
momentum output of the MSGCMG is limited to .049 Nms, where as the angular 
momentum supplied by the vectorable thrusters is essentially limitless, only limit being 
air supply. 
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Figure 32. Thruster Calibration Data 

3. Maxon Motor and EPOS 24/1 Positioning Controller 



Figure 33. Maxon Motor EPOS 24/1 Positioning Controller (Ref. [18]) 
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The Maxon Motor EPOS 24/1 positioning controller, shown in Figure 33, is used 
to control the brushless DC motors used to manipulate the MSGCMG and vectorable 
thrusters. The EPOS 24/1 for the MSGCMG is mounted on top of middle module deck 
while the two EPOS 24/Is for the dual vectorable thrusters are located underneath the 
deck of the middle module. The XPC Target control computer communicates with the 
EPOS 24/1 thru a RS-232 serial communication. Figure 34 illustrates the wiring 
schematic needed to setup the EPOS 24/1. Terminals 12 and 13 on the J1 connector are 
used to supply + 24 VDC and -24 VDC power respectively. This power comes from the 
24 VDC power terminal board located underneath the middle module, as shown in Figure 
10. A toggle switch, located on the middle module deck, is used to interrupt power to the 
EPOS 24/Is separately from the rest of the spacecraft simulator. It is necessary to 
remove power from the DC motors when repositioning them by hand to prevent damage 
to the motor or gears. Also, in order to establish the ‘zero position’ for each actuator, 
power must be removed, the actuator repositioned, and power then restored. 



Figure 34. Maxon Motor EPOS 24/1 Positioning Controller Wiring Schematic 

(Ref. [18]) 
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Each EPOS 24/1 uses three wires to establish its RS-232 serial communication. 
Terminals three, four, and five on the J2 connector correspond to the serial wires RXD, 
TXD, and GND respectively. The three serial wires from each EPOS 24/1 are combined 
into one wire bundle with a standard nine pin serial connector, allowing for easy wire 
disconnection between the spacecraft simulator modules. The opposite end of the 
combined wire bundle splits the individual EPOS 24/1 serial wires into separate nine pin 
serial connectors, labeled A, B, and C to allow for connection to the XPC Target control 
computer’s COM ports one, two, and four respectively. The wiring scheme used to 
establish the serial connections to each of the EPOS 24/1 s is listed in Table 11. 


EPOS 

CONNECTION 

WIRE 

COLOR 

WIRE BUNDLE 
PIN NUMBER 

COM PORT 
PIN NUMBER 

MSGCMG EPOS i 

COM 1) 


Connector A 

3 (RXD) 

Red 

Pin 2 

Pin 3 (TXD) 

4 (TXD) 

Orange 

Pin 1 

Pin 2 (RXD) 

5 (GND) 

Black 

Pin 3 

Pin 5 (GND) 

Vectorable Thruster #1 (COM2) 


Connector B 

3 (RXD) 

Yellow 

Pin 5 

Pin 3 (TXD) 

4 (TXD) 

Blue 

Pin 4 

Pin 2 (RXD) 

5 (GND) 

White 

Pin 9 

Pin 5 (GND) 

Vectorable Thruster #.2 (COM 4) 


Connector C 

3 (RXD) 

Green 

Pin 6 

Pin 3 (TXD) 

4 (TXD) 

Purple 

Pin 7 

Pin 2 (RXD) 

5 (GND) 

Gray 

Pin 8 

Pin 5 (GND) 


Table 11. Nine Pin Connector Wiring Scheme 


The data used to communicate with the EPOS 24/Is is transmitted 

asynchronously with one start bit, eight data bits, no parity and one stop bit. Each data 

byte is transmitted in sequential frames, shown in Figure 35, with each frame consisting 

of a header, a variably long data field and a 16-bit cyclic redundancy check (CRC) to 

verify data integrity, all in hexadecimal format. The header is a one word (16-bit) value 

composed of an 8-bit operation command (OpCode) followed by an 8-bit value that 

represents the number of words in the data field minus one. The data field contains the 

parameters of the particular message and is separated into groups of 16-bit words. The 

final component of the frame structure, the CRC, is a 16-bit word that must be calculated. 

In calculating the CRC, the code looks first at the header values followed by the high 
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byte and then the low byte of each sequential data value followed finally by 0x0000. 
Before transmitting, the string must be reorganized to place the low bytes first followed 
by the high byte for each data word and the CRC word. (Ref. [18]) 



Figure 35. EPOS 24/1 Command Frame Structure Diagram (Ref. [18]) 

MATLAB to communicate with the EPOS 24/1 was developed prior with the 

development of the MSGCMG. This code development is described in Ref. [8]. This 

MATLAB code, however, was not able to be compiled for use in the real-time XPC 

Target application. Therefore, the MATLAB code was converted to a SIMULINK model 

with embedded MATLAB functions, as shown in Figure 36. The SIMULINK model 

utilizes the XPC Target toolbox RS-232 blocks to establish communications with the 

individual COM ports of the XPC Target computer. The model is divided into two 

enable function blocks, set to execute sequentially. The first function block to execute 

initializes the EPOS 24/1 during the first second of the simulation while the second 

function block executes during the rest of the time and is used to send the velocity and 

report position commands to the EPOS 24/1 and receives the responses. The received 

EPOS 24/1 response is sent thru an embedded MATLAB function, listed in Appendix F, 

which parses out and interprets motor position information in degrees. This is then 
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converted to radians for use as feedback to the particular actuator control logic using that 
EPOS 24/1. This application will be further described in proceeding sections. 



Figure 36. EPOS 24/1 Position Controller SIMULINK Model 


The EPOS 24/1 initialization function block, shown in Figure 37, consists of a 
series of if action enable function blocks. These must be used to switch between different 
RS-232 send blocks. The RS-232 send block in the XPC Target toolbox only allows a 
fixed length of bytes to be sent to a COM port, a separate block must be used for each 
different command length. Command lengths can either be a single byte, seven bytes, or 
eleven bytes in length. Since the commands that need to be sent to initialize the EPOS 
24/1 are known and constant, constant blocks can be used to send them. Repeating 
sequence blocks are used to cycle thru the different commands and the required RS-232 
block that is setup for the length of the particular command. The initialization command 
sequence clears all faults, enables the EPOS 24/1, sets appropriate profile parameters on 
the controller, and sets the EPOS 24/1 to be in velocity mode. The decimal command 
sequence and its purpose are listed in Appendix F. 
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Figure 37. EPOS 24/1 Initialization SIMULINK Sub Model 

The function block used for normal communications with the EPOS 24/1, shown 
in Figure 38, is set up very similar to the initialization function block. A velocity 
command and a command for the EPOS 24/1 to report its current position are sent. The 
command sequence, listed in Appendix F, is sent in a continuously repeated loop at a 
frequency of 25 Hz with only the velocity command changing over time. The required 
velocity signal, sent from the controller, enters the function block in radians per second 
where it is then converted to degrees per second. The signal is then sent to an embedded 
MATLAB function, listed in Appendix F, which encodes the proper EPOS command to 
be sent. A time controlled switch is used to re-center the DC motor just prior to the end 
of the simulation run time. 
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Figure 38. EPOS 24/1 Driver SIMULINK Sub Model 
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III. CONTROLLER AND ACTUATOR MAPPING ALGORITHM 

DESIGN 

A. SPACECRAFT SIMULATOR DYNAMICS 



Figure 39. Spacecraft Simulator Dynamics Schematic 

The first step in developing a controller is to determine the dynamics for the 
spacecraft simulator. Figure 39 illustrates the reference frames used in developing the 
parameters to describe the spacecraft simulator’s orientation and the effect of the 
individual actuators. The spacecraft simulator has two degrees of translational freedom, 
described with coordinates X and Y, and one degree of rotational freedom about the third 
Z-axis, described with the coordinate 6. 

There are five control parameters that affect the spacecraft simulator. The first 
one is the torque generated by the MSGCMG, referred to by T MSGCMG . The remaining 
control parameters describe the effect of the dual vectorable thrusters. Each thruster as a 
force magnitude parameter, F ] or F 2 , and direction, a x or a 2 , determined by the slew 

angle of the individual vectorable thruster. The slew angle for each vectorable thruster is 

measured from an axis perpendicular to the faces of the spacecraft simulator that the 

particular thruster is mounted on with a right hand rule convention, as shown in Figure 

39. Thruster one is mounted on the front of the spacecraft simulator, while thruster two is 
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mounted on the opposite face. Equations(3),(4), and (5) describe the dynamics associated 
with the spacecraft simulator. The fact that there are more control parameters than there 
are dynamic equations and the non-linearity of the dynamic equations adds complexity to 
developing an actuator mapping algorithm. 


x = F t cos (a, + 0)-F 2 cos ( a 2 + 0) 

(3) 

y = F l sin (a, + 0) - F 2 sin (a 2 + 0) 

(4) 

~ Tmsgcmg sin ( cx { ) + F 2 d 2 sin ( cc : ) 

(5) 


B. CONTROLLER DESIGN 
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Figure 40. Guidance, Navigation, and Control SIMULINK Model (Ref. [9]) 


To compliment the modularity of the hardware design of the spacecraft simulator, 
the software architecture that was developed, particularly for the XPC Target control 
computer, also is modular in design. This is easily accomplished with the graphical block 
design of SIMULINK. The controller function block is a part of the Guidance, 
Navigation, and Control block, shown in Figure 40, of the overall SIMUFINK model 
shown in Figure 15. Further discussion of the modular design of the overall software 
architecture can be found in Ref. [9]. 
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Figure 41. Control and Mapping SIMULINK Model 


The control and mapping function block, shown in Figure 41, is divided in four 
parts. The first two, the controller and mapping blocks, are used to generate a required 
control signal and then map that signal to command signals that can be sent to the 
actuator blocks described in the previous section. The SIMULINK model developed to 
control the spacecraft simulator can also be used as a computer simulator to test various 
guidance and control algorithms. Therefore two addition blocks, actuator response and 
plant, were developed. These two blocks simulate the response of the actuators for the 
given actuator commands and the effect of those actuator responses on the overall 
spacecraft. 
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Figure 42. Controller SIMULINK Model 


As an initial step in the development of the AMPHIS test bed, a generic 
proportional-integral-derivative (PID) controller was developed, shown in Figure 42. 
This controller compares the reference signal state, which consists of x, y, 6, x, y, 6 


with the current state as determined by the state estimator. The functionality of the 
guidance system and state estimator is discussed in Ref. [9]. The controller generates a 
required absolute force signal of F X ,F and T . These absolute required force signals are 

used by the mapping block to generate required relative actuator commands to affect the 
required absolute forces. The gains for the PID controller were adjusted so that the 
system is slightly over-damped, minimizing the possibility of overshoots resulting in a 
collision. 
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ACTUATOR MAPPING ALGORITHM DEVELOPMENT 
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Figure 43. Actuator Mapping Algorithm SIMULINK Model 


The actuator mapping algorithm block, shown in Figure 43, takes the required 
absolute forces generate by the controller, along with current attitude and MSGCMG 
position information, and maps these to relative commanded output for each actuator. 
Individual actuator command logic blocks take the required actuator outputs and develop 
a command signal that can be sent directly to the actuator control blocks. 

Due to the multiple available control parameters, a method must be used to 
designate which actuator performs which tasks. To resolve this issue, a master/slave 
approach was adopted. The torque parameter generated by the MSGCMG operates as the 
master controller for attitude. The required absolute force signal is translated directly to a 
relative force vector for each vectorable thruster. Leveraging the ability of the thrusters 
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to slew and fire independently, MSGCMG position is used to generate a difference signal 
between the two thrusters. This difference signal applies a torque about the spacecraft to 
drive the MSGCMG back to the neutral position. This has the benefit of not only 
desaturating the MSGCMG if it should get saturated, by also of applying a torque to 
assist the MSGCMG as soon as the MSGCMG moves from the neutral position to 
respond to a required torque signal. The embedded MATLAB function to perform these 
functions is found in Appendix G. 

The individual actuator logic blocks convert the required actuator operation to an 
actuator command signal. For the thruster firing logic, this is done by ensuring that both 
vectorable thrusters are aligned in their commanded positions prior to generating a fire 
thruster command. The thruster slewing logic converts the required thruster position 
command and converts it to a thruster slew velocity based on current thruster position 
received from the actuator feedback. The MSGCMG logic block converts the torque 
command in a MSGCMG slew velocity. 


D. ACTUATOR AND PLANT RESPONSE MODEL 

To allow for the ability to use the SIMULINK software developed for the XPC 
Target control computer as a computer simulation model as well, actuator and plant 
response models had to be developed. The goal is to have the signals generated by these 
models to emulate the signals and responses that would be generated when the actual 
hardware is being used. The actuator response model, shown in Figure 44, receives the 
actuator command signals generated by the mapping model, and generates a response that 
is similar to the response that the actual actuators would generate, including the motor 
position feedback response of the EPOS 24/ls. For the MSGCMG, the velocity 
command is converted by to a torque signal. For the vectorable thrusters, the digital 
thruster fire signal is converted to a relative force. A manual switch is used to select 
whether the simulated actuator response or the actual actuator response is used by the rest 
of the software. 
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Figure 44. Actuator Simulated Response SIMULINK Model 

The plant response model, shown in Figure 45, uses actuator response signals 
(either simulated or actual) and simulates the dynamics and kinematics of the physical 
spacecraft simulator. The first block converts the actuator response signals and current 
attitude to convert the relative force to absolute forces. These absolute forces are used by 
a plant simulator, using the mass of moment of inertia characteristics of the actual 
spacecraft simulator, to propagate the spacecraft simulators response in the inertial frame. 
The state estimator block contains a manual switch that allows for the selection of either 
the plant response model generated state or the actual information from the onboard 
sensors to use as the state information by the rest of the SIMULINK model. The plant 
state information may also be used in the future by the state estimator as part of a Kalman 
Filter. 
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Figure 45. Physical Plant SIMULINK Model 
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IV. CONCLUSION 


A. RESULTS 

A sample maneuver was used to verify the effectiveness of the controller, 
mapping algorithm, as well as the rest of the hardware and software architecture that was 
developed for the AMPHIS test bed. The sample maneuver of moving to a point three 
meters in the x direction and 2 meters in the y direction, with a 90 degree rotation, was 
used to test the spacecraft computer simulator as well as hardware in the loop with the 
AMPHIS experimental test bed. 

1. Computer Simulation Results 

The computer simulation results, shown in Figure 46, demonstrate the effectives 
of the controller and actuator mapping algorithm. The overall system response was 
slightly over-damped, with the spacecraft simulator arriving at its target position in 
approximately 95 seconds. The maneuver required 25.34 Ns of thrust from the 
vectorable thrusters. 
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Figure 46. Simulation Results 


2. Hardware in the Loop Experimentation Results 

The hardware in the loop experimentation results, shown in Figure 47, 
demonstrate the effectives of the controller and actuator mapping algorithm to work on 
an actual three DOF test bed. The overall system response was very similar to the result 
obtained from the computer simulation, with the spacecraft simulator arriving at its target 
position in approximately 98 seconds. The maneuver required 32.56 Ns of thrust from 
the vectorable thrusters. There was more noise in the actual thruster and MSGCMG 
positions. This added noise, however, did not significantly affect the spacecraft 
simulators performance. The relative similarity between the simulation data and the 
experimentation data adds the confidence that the simulation models being used are 
realistic. 


56 






























































+■ Thrust 1 
• Thrust, 


40 60 

time (s) 




Figure 47. 


Hardware in the Loop Experimentation Results 
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B. 


FUTURE WORK 



Figure 48. AMPHIS Rendezvousing with AUDASS 


Further development of the AMPHIS test bed still needs to be completed. This 
includes the addition of docking mechanisms and the completed integration of the 
LiDAR sensor information into the state estimator. Also, the construction of additional 
spacecraft simulators needs to be completed to allow for true multi-agent spacecraft 
testing. One of the systemic problems encountered with the spacecraft simulator 
hardware is the wear on the air pads used in the floatation system. The addition of a sub 
micron air filter to the floatation should help alleviate this issue. 

Besides further hardware improvements, more robust and efficient controllers can 
now be developed and tested on the AMPHIS test bed. Also, different sensor and 
actuators can be developed and/or tested on the AMPHIS spacecraft simulator bus. Truly 
the AMPHIS test bed and POSF are in a condition were new and exciting autonomous 
multi-agent spacecraft controller design, development and testing can be done. 
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APPENDIX A. COMPONENT MANUFACTURER AND 
LIMITATION INFORMATION 

A. STRUCTURAL COMPONENTS 

Aluminum T-Slotted Framing System: 

Manufacturer: 80/20 


Vendor: 

McMaster-Carr 


http://www.mcmaster.com/ 


Static Dissipative Rigid Plastic Sheets (12x 12x14 inch) 
Vendor: McMaster-Carr 


B. FLOATATION SYSTEM 


Air Cylinders: 

Manufacturer: 

Pure Energy paintball bottle, Model #40669 

Vendor: 

Palmers Pursuit Shop 

(http://www.nalmer-pursuit.com) 

Limitations: 

3000 PSI, 68 cu in per 

QD Style fill fitting 


Stabilizer Dual Manifold System: 

Manufacturer: Palmers Pursuit Shop 


Limitations: 

Dual paintball bottles 


Regulated pressure between 0 and 300 PSI 


1/8 in OD- 1/16 in ID Low-Pressure Poly Tubing: 
Vendor: Palmers Pursuit Shop 

Limitations: 500 PSI 

1/8 NPT Brass Fittings (Various): 

Vendor: Palmers Pursuit Shop 

Limitations: 500 PSI 
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Solenoid 


Manufacturer: 

ASCO, Model #U 8225B002V 

Limitations: 

24 VDC, Normally Closed, rated for fluid and gas 

Maximum pressure of 125 PSI 

32 mm Air Bearings: 

Manufacturer: 

Aerodyne Belgium, PERARA Dextair (PE032) 

Vendor: 

Ameropean (No longer distributing) 

Limitations: 

Maximum Loading of 125 N @ 4 bar ensures 10 

micron air gap 


C. POWER DISTRIBUTION SYSTEM 


Lithium Ion Battery Packs: 

Manufacturer: 

UltraLife Batteries, Inc., Model #UBBL02 

httr>://www.ultralifebatteries.com/ 

Limitations: 

28 V for 6 AH or 14 V for 12 AH per battery pack 

DC-DC Converter Array: 

Manufacturer: 

Vicor, Standard VIP AC Array 

httn://www. vicr.com/ 

Limitations: 

Input Voltage 24 VDC 

Max power output per converter 100 W 

Mechanical Relay Array: 

Manufacturer: 

RTD Embedded Technologies, Model # DMR8 

h tt n: //w w w. rt d u s a. co m 

Limitations: 

±5 VDC operating 

Capable of supporting 8 separate devices 

D. ACTUATORS 


Thruster Solenoids: 


Manufacturer: 

Precision Dynamics, Inc., Model # EH2012-C204 
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Limitations: 

http://www.predvne.com 

+24 VDC, Normally Closed, rated for fluid or gas 

3-5 milliseconds switching capability 

Thruster Nozzles: 


Manufacturer: 

Silvent, Model # MJ5 

http://www.silvent.com 

Limitations: 

5.9 scfm air consumption, 1.8 N force with 72 PSI 

supply, M5x.5 connection 

MSCMG gyroscope: 

Manufacturer: 

Educational Innovations, Inc., Super Motorized 

Precision Gyroscope 

http://www.teachersource.com 

Limitations: 

±5 VDC, 12000 rpm rotor wheel rotation rate 


MSCMG gimbal motor and Vectorable Thruster slew motor: 
Manufacturer: Maxon Motor USA, 


Limitations: 

RE 16 motor, Model # 118730 

MR encoder, Model # 201940 

EPOS 24/1 Positioning Controller 

+9 to +24 VDC, RS-232 serial interface 1 kHz 

Update capability 

Max rotation rate of 16000 rpm 

Max continuous current of .614 A 

Max torque 4.98+10 Am 

Torque Constant of 8.11x10 3 Nm/A 

SENSORS 


LiDAR Sensor: 


Manufacturer: 

SICK AG, Model # LD-OEM 1000 

http://www.sick.com/home/en.html 
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Limitations: 

+24 VDC + 20%, RS-232 serial interface 

iGPS: 


Manufacturer: 

Metris 

Limitations: 

http ://w w w .metris .com/ 

Range between 2 and 40 m 

Requires Windows XP based PC running 

Workspace software 

Three-Axis Accelerometer: 


Manufacturer: 

Crossbow, Model # CXL02TG3 

http://www.xbow.com/ 

Limitations: 

+5 VDC, 2 pin in and 4 pin out (3 axis and temp) 

8.5+10 3 g bias stability and ±2 g input range 


Single Axis Fiber-Optic Rate Gyro: 

Manufacturer: KVH Industries, Inc., Model # DSP-3000 


Limitations: 

http://www.kvh.com/ 

Digital, 100 Hz asynchronous communication via 

RS-232 interface at 38,400 baud, + 5 VDC, input 

rate up to ± 375 deg/sec, Offset bias + 20 deg/hr 


COMMAND AND DATA HANDLING 


108 Mbps Wireless Router: 

Manufacturer: 

Netgear, Model # WGT624 v2 

http://www.netgear.com/ 

Limitations: 

+ 12 VDC 

Provides both wired and wired TCP/IP routing 


Pentium III PC-104 Computer: 

Manufacturer: Versalogic Corporation 


Limitations: 

http://www.versalogic.com/ 

+ 5 VDC 


Limitations: 







APPENDIX B. PROCEDURES FOR SETTING UP THE XPC 
TARGET CONTROL COMPUTER 


The following details the setup procedures for the Jaguar Pentium III CPU to 
include installation of the necessary MATLAB XPC Target code for the spacecraft 
simulators associated with the AMPHIS test bed. 

A. REQUIRED COMPONENTS LISTS 

1. Versalogic Jaguar Pentium III PC-104 computer 

2. 256 MB SDRAM Module 

3. 96 MB Disk on Chip (DOC) 

4. IDE, KVM, and VGA ribbon connector cables 

5. PC-104 power supply 

6. Diamond Systems DMM-32X-AT Analog LO PC-104 Module 

7. Versalogic Quad RS-232 Module 

8. 3.5” Floppy Disk Drive 

9. DOS 6.22 3.5” Setup Disk 

10. Blank 3.5” disk 

11. Desktop with Matlab2006b with Realtime Workshop Toolbox and Visual 
C++ installed. 

12. ATX power supply 

B. SETUP PROCEDURE 

1. Start MATLAB2006b residing on the desktop PC. 

2. At the prompt in the MATLAB command window, type xpcexplr and then 
expand the TargetPC icon in the XPC Target Hierarchy on the left of the 
screen. 
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3. Under the Communication icon select TCP/IP as the Host target 
communication under Communication protocol. Under the Target PC 
TCP/IP configuration, use the following: 

a. Target PC IP Address: 192.168.1.xl3, where x designates 

the spacecraft simulator number. (Refer to Table 3) 

b. TCP/IP target driver: 182559 

c. TCP/IP target port: 22222 

d. TCP/IP target bus: PCI 

e. LAN subnet mask address: 255.255.255.0 

f. TCP/IP gateway address: 255.255.255.255 

4. Under the Settings icon, set Target RAM size (MB) to Auto and select 16 
MB as the maximum model size. Leave all other boxes unchecked. 

5. Under the Appearance icon, check the Enable target scope and select none 
for the target mouse. 

6. Insert a blank 3 1/2 inch floppy disk into the desktop PC and then under 
the Configuration icon, select DOSLoader and then click Create Bootdisk. 

7. Remove the XPC Target DOSLoader disk from the desktop computer. 

8. Install DOC and SDRAM onto the PC-104 mother board. 

9. Setup the Quad RS-232 Module by setting the interrupts for COM ports 
three are four to IRQ five and 10 respectively. 

10. Setup the DMM-32X-AT Analog Module by setting jumper J5 pins one 
and two in and pins three, four, five, and six to out. Also, set jumper J6 
connection five to in and connections 10, P, and B to out. Connection R 
can be set either way. 

11. Construct the PC-104 stack with the Jaguar computer, a PC-104 power 
supply, DMM-32X-AT module, and the Quad RS-232 module. 

12. Attach connector cables to PC-104. 
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13. Attach 3.5” floppy disk drive. Insert DOS 6.22 floppy disk. 

14. Attach ATX power supply to PC-104 and floppy disk drive. 

15. Power up the computer. Press ‘delete’ during startup to enter the system 
CMOS. 

16. Verify that the A:\ drive is listed as one of the bootable devices and that 
the C:\ is not enabled in the Basic Settings. Under the Custom settings, 
disable the integrated COM ports by setting COM one and two to 
disabled. Also, enable the DOC by assigning it a memory address. The 
DOC will act as the C:\ if there is not HDD installed. 

17. Reboot. The computer should boot of the 3.5” DOS disk. Verify that the 
C: drive is available. At the A:\ prompt, format the C: drive by typing 
‘format c: /s’. This would load the system files onto the C:\ drive. 

18. Copy DOS onto the C: drive by typing ‘xcopy a: c:’ at the a:\ prompt. 
Remove the 3.5” DOS disk. 

19. Reboot. The computer should now boot off the C: drive (DOC) and load 
DOS. Insert the XPC Target DOSLoader disk. Copy the contents of the 
A: drive onto the C: drive by typing ‘xcopy a: c:’ at the C:\ prompt. 
Replace all duplicate files when prompted. 

20. Remove the 3.5” disk. Reboot. The computer should now reboot and load 
the XPC Target Application. The XPC Target computer is now ready to 
be integrated into the AMPHIS test bed. 
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APPENDIX C. PROCEDURES FOR SETTING UP WINDOWS XP 

BASED COMPUTER 

The following details the setup procedures for the Jaguar Pentium III CPU with 
Windows XP to include installation of the necessary Windows applications. 

A. REQUIRED COMPONENTS LISTS 

1. Versalogic Jaguar Pentium III PC-104 computer 

2. 256 MB SDRAM Module 

3. 3.5” laptop HDD 

4. IDE adapter the converts the female 40-pin HDD connection to a 44-pin 
3.5” HDD connection with a five VDC power adapter. 

5. IDE, KVM, USB, and VGA ribbon connector cables 

6. PC-104 3.5” HDD mounting bracket 

7. PC-104 power supply 

8. Versalogic Quad RS-232 Module 

9. CD-ROM drive 

10. Windows XP disk 

11. MATLAB 2006b installation disk 

12. iGPS Workspace installation disk 

13. ATX power supply 

B. SETUP PROCEDURE 

1. Install the SDRAM onto the Jaguar. 

2. Build the PC-104 stack with the Jaguar, PC-104 power supply, the Quad 
RS-232 module, and the 3.5” HDD mounted on the PC-104 HDD bracket. 

3. Attach IDE with adapter, KVM, VGA, USB and ATX power supply 
cables. Connect the CD-ROM. 
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4. 


Power on the computer. Hit the ‘delete’ key to enter the CMOS settings. 
Set the ATA DRV Assignment setting to ‘AUTOCONFIG, LBA’. Verify 
that Drive C: is set to IDE 0 and drive D: is set to IDE 1. Verify that 
CDROM is listed on the boot order. 

5. Insert the Windows XP installation CD. Reboot the computer. 

6. Install Windows XP. 

7. Install MATLAB 2006b. 

8. Install iGPS software per the instructions listed in Ref. [8]. 

9. Install a remote desktop software to remotely access the Windows XP 
computer. 

10. Setup Windows XP account to boot up with user login. 

11. Using Notepad, create a *.bat file to automatically load iGPS software in 
high priority mode. Use the following commands: 

cd c:\Program Files\Arc Second\WorkSpace\ 

start /high workspace 

(ENSURE TO SAVE FILE WITH .bat extension. 

12. The Windows XP computer is now ready to be integrated into the 
AMPHIS test bed. 
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APPENDIX D. PRE-EXPERIMENTATION SET-UP 

PROCEDURES 


A. VEHICLE START-UP PROCEDURES 

Prior to using the AMPHIS spacecraft simulator, ensure that both power cables 
are properly connected to the battery packs and that the vehicle is in a safe location with 
respect to the edges of the simulation floor. Additionally, ensure the air cylinders are 
filled to 3000 psi. The procedures for battery charging and refilling the air cylinders can 
be found in Ref. [8]. BE CAREFULL OF STATIC CHARGE WHILE IN 
CONTACT WITH SPACECRAFT SIMULATOR ON THE EPOXY FLOOR. 
WILL CAUSE ALL COMPUTERS TO REBOOT!! 

1. Verify that all actuators (MSGCMG and both vectorable thrusters) are in 
their neutral or zero position. 

2. Turn the simulator power switch to the ON position. All components 
should turn on, with the exception of iGPS. 

3. After waiting approximately 2 minutes to allow the on-board Versalogic 
PC-104 to boot, energize the iGPS system by turning its power switch to 
on. 

4. Connect to the wireless network for the AMPHIS prototype spacecraft 
simulator (AMPHISNET) from the demonstration computer. 

5. Click on the Anyplace Control Admin Module desktop icon on the 
demonstration computer. 

6. When the connection window appears, highlight the computer 192.168.1.2 
by clicking on it and the click the connect icon. This will bring up a new 
screen from which you can control the on-board computer. 

7. Establish communications with the iGPS receiver by turning on the 
receiver COM port in the iGPS Workspace application. 
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8. Build and load the XPC Target SIMULINK model (Robot.mdl) onto the 
XOC Target control computer. Verify that the manual switches are set for 
their intended positions. (Either simulation or hardware in the loop) 

9. Run the Lynx based iGPS communications device on the Lynx computer. 

10. Open the Windows XP computer SIMULINK model (windows.mdl) on 
the Windows XP computer. 

11. If a hardware in the loop experiment is being executed, turn on the manual 
air valves to both the floatation and propulsion systems. 

12. Run the Windows XP SIMULINK model. This model will execute the 
XPC Target control computer real-time application and retrieve all the 
data after the simulation and save it in a *.mat located in the XPCDatalog 
folder, named with the simulation run time. 
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APPENDIX E. DEVELOPED MATLAB CODE TO 
COMMUNICATE WITH KVH DSP-300 FIBER OPTIC GYRO 


A. WINDOWS XP SIMULINK CODE 

1. opensim.m 

ooooooooooooooooooooooooooooooooooooooooooooooooooooo 

% Simulink Initialization Function used to open the % 
% COM port (COM3) for the Fiber Optic Gyro. % 

ooooooooooooooooooooooooooooooooooooooooooooooooooooo 


global f; 

f = serial (' COM3 ') ; 

f.BaudRate = 38400; 

% Ensures at least one full data is stored in the buffer, 
f.InputBufferSize = 44; 

f.OutputBufferSize = 1; 
fopen(f); 


2. closesim.m 

9 ' 2 ' 2 ' 2 ' 9 ' 2 ' 2 ' 2 ' 9 ' 2 ' 2 ' 2 ' 9 ' 2 ' 2 ' 2 ' 9 ' 2 ' 9 ' 2 ' 9 ' 2 ' 2 ' 2 ' 9 ' 2 ' 9 ' 2 ' 9 ' 2 ' 2 ' 2 ' 9 ' 2 ' 9 ' 2 ' 9 ' 2 ' 9 ' 2 ' 9 ' 2 ' 9 - 2 ' 9 ' 2 ' 2 ' 2 ' 9 ' 2 ' 9 ' 2 ' 9 ' 2 ' 9 ' 

ooooooooooooooooooooooooooooooooooooooooooooooooooooooo 

% SIMULINK Function used at the end of the simulation % 
% to close the COM port used by the Fiber Optic Gyro. % 

9 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 - 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 9 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 

ooooooooooooooooooooooooooooooooooooooooooooooooooooooo 


global f 
fclose(f) 
clear f 

3. readsim.m 


function out = readsim(x) 


9 - 2 ' 2 ' 9 ' 2 - 9 ' 5 - 9 ' 2 ' 2 ' 2 - 2 ' 2 - 9 ' 2 - 9 ' 2 - 9 ' 2 - 2 ' 2 - 9 ' 2 - 2 ' 2 - 9 ' 2 - 2 ' 5 - 9 ' 2 - 9 ' 2 - 9 ' 2 - 9 ' 5 - 9 ' 2 - 9 ' 2 - 2 ' 2 - 2 ' 2 - 9 ' 2 ' 2 ' 2 - 9 ' 2 - 9 ' 5 - 9 ' 2 ' 9 ' 2 - 9 ' 5 ' 9 - 2 - 9 - 9 - 9 - 9 - 9 - 9 - 9 - 

oooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooo 

%Function to read ASCII data from the KVH DSP-300 Fiber Optic Gyro 
%Ensure that the serial port is already initialized with 'opensim.m' 

9 ' 2 ' 9 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 9 ' 2 ' 9 ' 2 ' 2 ' 2 ' 9 ' 2 ' 2 ' 2 ' 9 ' 2 ' 9 ' 2 ' 9 ' 2 ' 2 ' 2 ' 9 ' 2 ' 9 ' 2 ' 9 ' 2 ' 2 ' 2 ' 9 ' 2 ' 9 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 9 ' 2 ' 2 ' 2 ' 9 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 9 ' 2 ' 9 ' 2 ' 9 ' 2 ' 2 ' 2 - 

oooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooo 

global f last 
out=0; 

%Ensures buffer is full and reads new data. 

%If buffer not full, outputs last good data. 

k=f.BytesAvailable; 
if k==44 

data = fread(f,k); 
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last = data; 

else 

data = last; 

end 

%Searches thru data to find the rate information. 
%Converts ASCII rate info to double. 

for t=l:27 

test=[data(t:t + 6) ' ]; 

if all(test==[49 13 10 32 32 32 32]) 

rate=str2num(strcat(char(data(t+7:t+17))')); 

end 

end 

out=rate; 

B. XPC TARGET CODE 


1. Embedded Matlab Function ‘Parse’ 


function y = fcn(u) 


9 ' 2 ' 2 ' 2 ' 9 ' 2 ' 2 ' 2 ' 2 ' 2 ' 9 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 9 ' 2 ' 2 ' 2 ' 2 ' 2 ' 9 ' 2 ' 2 ' 2 ' 9 ' 2 ' 9 ' 2 ' 2 ' 2 ' 9 ' 2 ' 2 ' 2 ' 2 ' 2 ' 9 ' 2 ' 9 ' 2 ' 9 ' 2 ' 9 ' 2 ' 2 ' 2 ' 9 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 9 ' 2 ' 9 ' 2 ' 9 ' 2 - 9 - 2 ' 9 ' 2 ' 9 - 

ooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooo 

% Function to parse the ASCII data from the 
% KVH DSP-300 Fiber Optic Gyro data stream. 

ooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooo 


% Establishes variable class and size, 
d = double(u); 
test = [0 0 0 0 0] ; 
rate =[00000000000]; 

%Parses out ASCII rate information from data stream. 
i=l; 

for i=l:29 

test = [d(i) d(i+l) d(i+2) d(i+3) d(i+4)]; 
if all (test==[10 32 32 32 32]) 

rate = [d(i+5) d(i+6) d(i+7) d(i+8) d(i+9) d(i+10) d(i+ll)... 
d (i + 12) d(i+13) d(i + 14) d(i+15)]; 

end 

end 


%Converts output to unsigned 8 bit integer for ASCII Decode Block. 
y=uint8(rate 1 ); 
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APPENDIX F. DEVELOPED MATLAB CODE TO 
COMMUNICATE WITH MAXON MOTOR EPOS 24/1 
POSITIONING CONTROLLER 


1. Parse/Decode Embedded MATLAB Function 


function y = fcn(u) 

ooooooooooooooooooooooooooooooooooooooooooooooooooooooooo 

% Embedded MATLAB Function the parses out and decodes % 

% motor position information from the EPOS 24/1 % 

9 - 2 - 2 - 2 ' 2 - 2 ' 2 ' 9 ' 2 - 2 ' 2 ' 9 ' 2 - 2 ' 2 ' 2 ' 2 - 2 ' 2 - 2 ' 2 - 2 ' 2 - 9 ' 2 - 2 ' 2 - 9 ' 2 - 2 ' 2 - 9 ' 2 - 2 - 2 - 2 ' 2 - 2 ' 2 ' 2 ' 2 - 2 ' 2 - 9 ' 2 - 2 - 2 ' 2 ' 2 - 2 ' 2 ' 2 ' 2 ' 9 ' 2 ' 2 ' 2 - 

ooooooooooooooooooooooooooooooooooooooooooooooooooooooooo 

%Declares variable sizes and types for emmbedded funct. 

d = double (u); 

test = [00000000]; 

encdat = [0 0 0 0] ; 

i=i; 

%Searches thru EPOS response to find bytes associated 
%with motor position, 
for i=l:25 

test = [d(i) d(i+l) d(i+2) d(i+3) d(i+4) d(i+5) d(i+6) d(i+7)] 
%Header right before Position info 
if all(test == [79 79 0 3 0 0 0 0]) ; 

encdat = [d(i+8) d(i+9) d(i+10) d(i+ll)]; 

end 

end 

%Converts position info from hexadecimal format 
%to decimal in number of encoder counts. 

pos = encdat(4)*16777216+encdat(3)*65536+encdat(2)*256+encdat(1); 

%Position info is two's compliment format. 

%This checks for negative postion and converts 
%encoder counts to degrees, 
if pos > 2147483648 

pos—(pos-4294967296)*(360/172032); 

else 

pos=pos*(360/172032); 

end 


%This modulates position about 360 
%i.e. 720 degrees == 360. 
q=fix(pos/360); 
if abs(q)>=1 

pos=pos-q*360; 

end 


y=pos; 
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Initialization Command Sequence 


Decimal Command 

17 

[3, 64, 96, 0, 1, 128, 0,0, 0,57,248] 

79_ 

79_ 

16_ 

[1, 65, 96, 0, 1, 171,240] _ 

79_ 

79_ 

17_ 

[3,64,96,0,1,6,0,0,0,195,113] 

79_ 

79_ 

17_ 

[1,65, 96, 0, 1, 171,240] _ 

79_ 

79_ 

17_ 

[3,64,96,0,1,15,0,0,0,82,239] 

79_ 

79_ 

17_ 

[1,65, 96, 0, 1, 171,240] _ 

79_ 

79_ 

17_ 

[3,64,96,0,1,15,1,0,0,230,135] 

79_ 

79_ 

17_ 

[1,65, 96, 0, 1, 171,240] _ 

79_ 

79_ 

17_ 

[3,246,96,1,1,209,1,0,0,115,30] 

79_ 

79_ 

17_ 

[3,246,96,2,1,253,1,0,0,6,3] 

79_ 

79_ 

17_ 

[3,249,96,1,1,204,5,0,0,89,95] 

79_ 

79_ 

17_ 

[3,249,96,2,1,110,1,0,0,134,168] 

79_ 

79_ 

17_ 

[3,96,96,0,1,254,0,0,0,198,85] 

79_ 

79 


Purpose 


Opcode _ 

Clear Faults 

OK _ 

OK _ 

Opcode _ 

Prepare Enable 

OK _ 

OK _ 

Opcode _ 

Enable 1 _ 

OK _ 

OK _ 

Opcode _ 

Prepare Enable 

OK _ 

OK _ 

Opcode _ 

Enable 2 _ 

OK _ 

OK _ 

Opcode _ 

Prepare Enable 

OK _ 

OK _ 

Opcode _ 

Enable 3 _ 

OK _ 

OK _ 

Opcode _ 

Finish Enable 

OK _ 

OK _ 

Opcode _ 

Set Pos P Gain 

OK _ 

OK _ 

Opcode _ 

Set Pos I Gain 

OK _ 

OK _ 

Opcode _ 

Set Vel P Gain 

OK _ 

OK _ 

Opcode _ 

Set Vel I Gain 

OK _ 

OK _ 

Opcode _ 

Se t Velocity M 
OK 
OK 




3. Normal Command Sequence 


Decimal Command 

Purpose 

17 

Opcode 

Generated by Embedded 
MATLAB Func 

Velocity Command 

79 

OK 

79 

OK 

17 

Opcode 

[1,100,96,0,1,157,157] 

Report Position Command 

79 

OK 

79 

OK 


4. Velocity Command Embedded MATLAB Function 

function y = fcn(u) 

ooooooooooooooooooooooooooooooooooooooooooooooooooooooo 

% This Embedded MATLAB Function receives a desired % 
% velocity signal (degs/sec) and encodes a velocity % 
% command for the EPOS 24/1 Positioning Controllel. % 

9 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 - 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 

ooooooooooooooooooooooooooooooooooooooooooooooooooooooo 

% Initializes variable sizes and types 

vell=u; 

crcn = [0 0] ; 

vpn = [0 0]; 

vpn2 = [0 0] ; 

% Converts velocity (degs/s) to two's complimnetary 
% least significant byte leading decimal number of 
% representing RPMs . 

vel = floor(vell*60*(16000/84)/360); 
if vel < 0 

vel=4294967296+vel; 

end 

vel2=uint32(vel); 

vpp = bitand(vel2,65535); 

vpp2 = bitshift(vel2,-16); 

vp = double(vpp); 

vp2 = double(vpp2); 

vpn(2) = floor(vp/256); 

vpn(l) = vp-vpn(2)*256; 

vpn2(2) = floor(vp2/256) ; 

vpn2(l) = vp2-vpn2(2)*256; 

% Concatenates the bytes representing the desired RPMs 
% with the velocity command header, 
dat = [3, 107,32,0,1, vpn, vpn2] ; 

% Calculates the CRC for the given velocity command 
m = 2; 
d = dat; 
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1 = d (1) + 1; 

d(1) = 256*17+d(1); 

i=2; 

crc2=0; 

for i = 2:1+1 

d(i) = d(m+1)*256+d(m); 
m = m+2; 

end 

d(1+2) = 0; 
m=l+2; 

crc = uintl6 (0) ; 

for i = 1: m 

shifter = uintl6 (32768); 
c = uintl6(d(i)); 
while all(shifter) 

carry = bitand(crc,uintl6 (32768)); 
crc = uintl6(bitshift(crc,1)); 

if all(bitand(c,shifter)), crc = crc + 1; end 
if all(carry) , crc = bitxor(crc,uintl6(4129)); 
shifter = uintl6(bitshift(shifter,-1)) ; 

end 

end 

crc2=double(crc) ; 

crcn (2) = floor(crc2/256); 

crcn(l) = crc2-crcn(2)*256; 

% Concatenates the CRC bytes with the velocity 
% command and returns the complete 11 byte command, 
y = [dat,crcn]'; 


end 
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APPENDIX G. DEVELOPED MATLAB CODE FOR 
CONTROLLER AND ACTUATOR MAPPING ALGORITHMS 


function [Flc, ale,F2c,a2c,Tcmg] = fcn(Fx,Fy,T,theta,del) 


ooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooo 

% This Embedded MATLAB Function receives required absolute % 
% force information, attitude, and MSGCMG position and % 

% develops required actuator outputs in the form of dual % 
% vectorable thruster force and position and torque output % 
% for the MSGCMG. % 

9 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 2 ' 9 ' 2 ' 2 ' 2 ' 9 ' 2 ' 9 ' 2 ' 9 ' 2 ' 2 ' 2 ' 9 ' 9 ' 9 ' 2 ' 9 ' 2 ' 2 ' 2 ' 9 ' 2 ' 9 ' 2 ' 9 ' 2 ' 9 ' 2 ' 9 ' 2 ' 2 ' 2 ' 9 ' 2 ' 2 ' 2 ' 9 ' 2 ' 9 ' 2 ' 2 - 2 ' 2 ' 2 ' 9 ' 2 ' 2 ' 2 ' 9 - 

ooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooo 


% Established max thruster force and max differential angle 
% between the thrusters. 

maxF=.28; 

maxalpha=35*pi/180; 

% Modulates current attitude about 360 degs (2 Pi). 
m=fix(theta/(2*pi)); 
theta=theta-m*2*pi; 

% Converts the required absolute forces (Fx & Fy) into a 
% RELATIVE force vector of Fc and ac. 

F=[Fx, Fy] ; 

Fc=norm(F); 

ac=atan2(Fy,Fx)-theta; 

% Sends required torque signal directly to MSGCMG logic 
Tcmg=T; 

% Generates angle differential (alpha) between the dual 
% vectorable thrusters and torque (Tc) based on MSGCMG pos. 
Tc=del*.01; 

alpha=exp(abs(Tc))*sign(Tc); 
if abs(alpha)>maxalpha; 

alpha=maxalpha*sign(Tc); 

end 

% Determines how to apply alpha and Tc based 
% on thruster position 
if ac<0 && ac>-pi; 

Fl=.5*Fc-Tc; 

F2=.5*Fc+Tc; 

else 

Fl=.5*Fc+Tc; 

F2=.5*Fc-Tc; 

end 

if ac>-pi/2 && ac<pi/2 
al=ac+alpha; 
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a2=ac-alpha; 


else 

al=ac-alpha; 
a2=ac+alpha; 

end 

% Converts negative forces to positive forces 
if F1<0 

alc=-al; 

Flc=-Fl; 

else 

alc=al; 

Flc=Fl; 

end 

if F2<0 

a2c=-a2; 

F2c=~F2; 

else 

a2c=a2; 

F2c=F2; 

end 

% Converts thruster 1 from a force to a thrust. 

% Thruster 2 is converted by physical orientation. 
alc=alc+pi; 

% Ensures that the commanded thruster position 
% is between +/- 180 degs (+/- pi). 
if alc>pi 

alc=alc-2*pi; 
elseif alc<-pi 

alc=alc+2*pi; 

else 

alc=alc; 

end 

if a2c>pi 

a2c=a2c-2*pi; 
elseif a2c<-pi 

a2c=a2c+2*pi; 

else 

a2c=a2c; 

end 
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